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METHOD FOR TEACHING WELDING 
TORCH ORIENTATION 

BACKGROUND OF THE INVENTION 

1. Field of the Invention 5 
The present invention relates to a method for teaching a 

robot capable of implementing a proper torch orientation in 
performing welding work by play back operation of the 
robot supporting a torch for arc welding. 1Q 

2. Description of the Related Art 

Where a welding work is performed by play back opera- 
tion of a robot supporting a welding torch (hereinafter 
referred to as torch), the orientation of the torch, as well as 
the position (three dimensional position) of its head, must be 15 
properly maintained during the movement of the robot. If the 
torch orientation is improper, a required welding work can 
not be accomplished even when the torch head moves on a 
welding path to trace properly a weld line. Especially, for a 
weld line path having a large curvature such as corner 20 
portion, teaching requiring the torch to sharply change its 
orientation should be avoided. 

FIG. 1 schematically illustrates a conventional method of 
teaching the position and orientation of a torch to a robot, 
which is generally utilized. In FIG. 1, a path 25 
A->B-*C->D->E-*F is a welding path along a weld line, in 
which reference numeral 1 designates a torch mounted on a 
robot arm (not shown); and reference numeral 2 designates 
a tool center point set to the head of the torch 1. The tool 
center point 2 is set with a tool coordinate system of three 30 
rectangular X Y Z axes; the origin of the coordinate system 
is the tool center point 2, and one axis (Z axis) is coincident 
with the axial center of the torch 1. Thus, it is hereinafter 
defined that "torch position" refers to the position of the tool 
center point 2, that is, the origin of the coordinate system, ~ 35 
and that "torch orientation" refers to the orientation of the 
coordinate system. Among many torches shown in FIG. 1, 
only the torch positioned at a start point A of the welding 
path is affixed by the reference numerals. 

Now, with reference to FIG. 1, a conventional teaching 40 
procedure will be explained below. 

(1) The robot is advanced by jog feed until the torch 
position (tool center point 2) coincides with the start point A 
of the welding path, and then the position of the start point 4$ 
A is taught to the robot. At this time, as torch orientation, an 
optimum welding orientation (the one shown as a) of the 
welding path starting from the start point A is taught. 

(2) Without changing the taught orientation, the robot is 
moved along the welding path until the torch position 5Q 
coincides with a position PB located a little before a point B 
(path junction point B) at which the welding path is bent; 
and then the position PB is taught. As torch orientation, the 
orientation a having been taught at the point A is taught as 

it is. 55 

(3) The robot is advanced further from the position PB 
until the torch position coincides with the path junction point 
B, and then the path junction point B is taught. As torch 
orientation, an intermediate orientation b r between an opti- 
mum orientation (given as b), as a welding orientation of the so 
welding path starting from the start point B, and the orien- 
tation a having been taught at the start point A or the position 
PB is taught. 

(4) The robot is advanced further from the point B until 
the torch position coincides with the position QB located a 65 
little beyond the path junction point B, and then the position 
QB is taught. As the torch orientation, the optimum orien- 
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tation b as the welding orientation of the welding path 
starting with the start point B is taught. 

(5) Thereafter, the same operations are repeated to teach 
the positions of points PC, C, QC, PD, D, QD, PE, E, QE, 
and an end point F, and in addition, as the torch orientation, 
the orientations b, c', c, c, d', d, d, e', e, e at these points are 
taught. 

The meanings of these codes are as follows: 

c: Optimum torch orientation at path CD 

d: Optimum torch orientation at path DE 

e: Optimum torch orientation at path EF 

c 1 : Intermediate orientation between orientations c and d 

d f : Intermediate orientation between orientations d and e 

However, in the above-mentioned conventional teaching 
method, and the end point F, the position and orientation of 
the points PB, QB, PC, QC . . . positioned near before and 
behind the junction points B, C . . . must be taught as well 
as the start point A, the junction points B, C . . . , so that there 
is a disadvantage that the teaching work load becomes large. 
Particularly, it requires a high skill and a long period of time 
to perform correctly teaching of the torch orientation affect- 
ing welding accuracy. 

Particularly, the torch orientation at the point at which the 
welding path is bent, that is, the path junction points B, C . . . 
must be taught in such a manner that the change in the torch 
orientation must be smoothly performed in a small section 
ranging from before to behind these junction points. 
However, any simple and objective method for finding out 
such orientation is not available, thereby relying on the 
intuition and experience of an operator. Therefore, it is 
difficult to obtain a stable welding accuracy which is not 
influenced by the skillfulness of an operator. 

-OBJECTS AND SUMMARY OF THE 
INVENTION 

An object of the present invention is to provide a method 
of teaching a robot capable of implementing a proper torch 
orientation in performing welding work by play back opera- 
tion of the robot supporting a torch for arc welding, with a 
less work load. 

The teaching according to the present invention follows 
substantially the following procedure: 

(1) While advancing a robot by jog feed, the position of the 
start point and end point on a weld line defining a section, 
and of the junction points between these points are taught. 
However, instead of this teaching, there may be used 
either the position data of already prepared program or the 
position data prepared off line. 

(2) A required torch welding orientation for respective 
sections is set on the basis of a reference plane. 

(3) On the basis of both the position data of the junction 
points thus taught and the torch orientation set with 
respect to the sections starting from the junction points, a 
basic welding orientation for each section is calculated. 

(4) One or a plurality of auxiliary points are set on the 
respective weld lines before and behind each junction 
point. Among these auxiliary points, for the most behind 
auxiliary point, the basic welding orientation for the 
section just before the present junction point is set, while 
for the most front auxiliary point, the basic welding 
orientation for the section starting from the present junc- 
tion point is set. Further, the intermediate auxiliary points 
and junction points, with most behind and most front 
auxiliary points excluded, are given intermediate orien- 
tations between the basic welding orientations, which are 
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different from each other according to the arrangement 

order. The torch orientation is set so as to be changed 

smoothly near the junction points. 

Using the method of the present invention, it is possible 
to produce automatically a program for realizing a desired 
torch orientation, by deliberately teaching only the position 
of the start point, the end point and junction points which 
divide the intermediate weld line into a plurality of sections, 
without paying a particular attention to the welding torch 
orientation. Further, in calculating the welding orientation, it 
is also possible to reflect the orientation around the torch 
axis which was taught at the beginning. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The foregoing and other objects and feature of the inven- 
tion will become apparent from the following description of 
preferred embodiments of the invention with respect to the 
accompanying drawings, in which: 

FIG. 1 is a view for explaining a conventional method for 
teaching the position and orientation of a torch with respect 
to a robot, which is most generally used heretofore; 

FIGS. 2A-2C are views showing sequentially a procedure 
for performing a method according to the present invention; 

FIG. 3 is a view for explaining the orientation of a torch; 

FIG. 4 is a view for explaining setting of a coordinate 
system and a reference plane for the sections AB, BC, and 
setting of a torch orientation based on the reference plane; 

FIG. 5 is a view for explaining how to determine the 
coordinate system for the section AB; 

FIG. 6 is a view illustrating an example of an operation 
screen for a torch orientation quick teach function; 

FIG. 7 is a view illustrating an example of an automatic 
welding orientation calculating screen; . ... 

FIG. 8 is a view illustrating an execution screen for 
automatic calculation for smooth orientation change; 

FIG. 9 illustrates, in the form of a major-part block 
diagram, the outline of the configuration of a welding robot 
system used in the present invention; 

FIG. 10 is a view for explaining auxiliary points set before 
and behind the junction point B; 

FIG. 11 is a view showing a circumference-shaped weld- 
ing path connecting two semicircle sections; and 

FIG. 12 is a flow chart describing the outline of an 
operation/processing procedure to be carried out after dis- 
playing of the operation screen of the torch orientation quick 
teach function. 

DETAILED DESCRIPTION OF THE 
PREFERRED EMBODIMENTS 

With reference to FIG. 9, the outline of the configuration 
of a robot system used in this embodiment will be explained. 
A central processing unit (hereinafter referred to as CPU) 11 
in a robot controller 10 for controlling a welding robot is 
connected through a bus 20 with a memory 12 formed of a 
ROM, a memory 13 formed of a RAM, a nonvolatile 
memory 14, an axis controller 15, a teaching pendant 18 
including a liquid crystal display (LCD) 17 and a general 
purpose interface 19. 

The axis control part 15 is connected through a servo 
circuit 16 to a robot (body mechanism unit) 30. Also, the 
general purpose interface 19 is connected to a power source 
unit 40. The power source unit 40 has a function of con- 
trolling a welding voltage and welding current to be supplied 
to the torch 1 according to the instruction from the CPU 11. 
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The ROM 12 is stored with various programs by which the 
CPU 11 controls the robot (body mechanism unit) 30, the 
power source unit 40 and the robot controller 10 itself. 
The RAM 13 is a memory utilized for the temporary 

5 storage and calculation of data. Also, the nonvolatile 
memory 14 is stored with various programs and parameter 
set values for specifying the content of the motion of the 
welding robot system. Programs and associated settings to 
cause the CPU 11 to execute various processing (whose 

10 contents will be described later) for embodying the present 
invention are divided into the ROM 12 and the nonvolatile 
memory 14 for storage. 

A procedure for performing the teaching according to the 
present invention using the above-described welding robot 
system will be explained hereinafter, 

Teaching method of the present invention is accomplished 
by performing the following three steps, that is, step (1), step 
(2) and step (3). The three steps correspond to FIGS. 2A, 2B, 
and 2C. The weld line A-F and the torch 1 in FIG. 2 are the 
same as those shown in FIG. 1. 

20 1. [Step (1)] 

At this step, the position data of respective points includ- 
ing the start point A, end point F, and intermediate path 
junction points B, C, . . . E on the welding path is obtained. 
This work is accomplished, as shown in FIG. 2A, by 

25 advancing the robot by jog feed to cause the respective torch 
positions (tool center point 2) to be coincident with the start 
point A, end point F, and intermediate path junction points 
B, C, . . . E on the welding path, and then teaching the 
position of the respective points to the robot. At that time, 

30 although the torch orientation is to be also simultaneously 
taught, the torch orientation is not considered at this step. 

At this step, instead the above-mentioned teaching, either 
the position data of already prepared program relating to the 
respective points A through F or the position data 

-35 (orientation data is not necessary) prepared off line may be 
transferred to the robot controller 10. 
2. [Step (2)] 

At this step, the welding orientation (hereinafter referred 
to as basic orientation) which is believed to be optimum for 
40 each of the sections AB, BC, . . . EF is automatically 
calculated. 

First, a reference plane for defining the torch orientation 
is specified, and then an angle parameter representing the 
orientation is inputted into the robot controller 10. Then, on 

45 the basis of the inputted angle parameter and the position 
date taught at the above-mentioned step(l), the welding 
orientation (basic orientation) which is believed to be opti- 
mum for each of the sections is determined by the software 
processing of automatic calculation, and the calculated 

50 results is stored in the nonvolatile memory 14, This causes 
the program including the position data obtained by the 
teaching at step (1) to be transformed into a program 
teaching the torch orientation as shown in FIG. 2B. 
In FIG. 2B, the orientation a calculated for the start point 

55 A is a torch orientation which is believed to be optimum for 
the welding in the section AB; the orientation b calculated 
for the start point B is a torch orientation which is believed 
to be optimum for the welding in the section BC; and 
hereafter in the same manner, the orientation e calculated for 

60 the start point E is a torch orientation which is believed to 
be optimum for the welding in the section EF. These 
orientations a, b . . . e represent basic orientations in the 
respective sections. The basic orientation e at the end point 
F is the same as the basic orientation e in the section E-F 

65 including the end point F. 

The parameters to be inputted to calculate the basic 
orientation and a method for calculating the basic orientation 
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will be explained hereinafter. First, with reference to FIG. 3, coordinate system. As described above, from the direction of 

the reference plane and the angle parameters (inclination the section (A-»B) and the normal vector <n> of the 

angle and forward angle) will be explained. reference plane, the XYZ coordinate in this section can be 

First, a reference plane, which is used as a reference for S et. Therefore, in setting a coordinate system in a section, it 
specifying an inclination angle described later, is set. FIG. 3 5 does not matter whether the direction of the section is within 
shows a relationship among the reference plane, the incli- ^ re f erenc e plane. For example, even when the line con- 
nation angle and the forward angle, taking the path A-B as necting the point A and point B is not placed on the reference 
an example preference plane p\ though set by teaching the pkne p> the ^ set ^ the directk)n A _ B; tne Y . axiS) ^ 
reference plane to the robot as described later, can be the direction perpendicular to the X-axis and the normal Une 
replaced by a known plane such as a robot installing plane. u of , he reference lane . and the z ^ ia the direction 
The reference plane may be also set by inputting directly the adicular t0 me x . axis and me y.axis. 
data specifying the normal vector of the reference plane. Hereafter, in this manner, for each of the sections AB, BC 

When assuming a plane y on which a straight line _ respective coordinate system (which system is here- 
representing the direction of the torch 1 (Z-axis direction of called [IJVW]) h defined> and for each on the 
a tool coordinate system) is placed with respect to the M coordinate system [UVW], the inclination angle 6 and the <(. 
reference plane p, an angle between the plane y and the ^ specif^ 

reference plane (3 is defined as an "inclination angle 6". 2 b . How tQ cakulate ^ torch orientation (tool vector) 

When standing a vertical line g to the straight line A-B indenting the specified inclination angle 8 and the 

representing the welding path from the ^ool center point 2 in forward an ^ e ^ on ^ determined coordinate syste m 

a manner such that it is placed on the plane 7, an angle 20 njvw] 

between the straight line representing the direction of the ^ matter tQ be ^ ^ ntion when calculatill g ^ t0 rch 

torch 1 (Z-axis direction of a tool coordinate system) and the orientation ^ ^ m a general ldbot having six of 

straight line g * defined as a "forward-angle <(. ; freedom> the torch orientation can be unconditionally 

When the reference plane p was set, then a three dimen- defiaed onl b determining a sp i n ang l e (an angle repre- 

sional rectangular coordinate system for calculating the 2J ^ ^ orientation of a rotation md ^ ^ of the 

torch orientation is set for each path by using the vector m torch x Qt around the ^ of ^ tool coordinate system ) 

the path direction and the normal vector of the reference ^ addition tQ the inclination angk e and foe forward angle 

plane. The torch orientation is expressed by a 3x3 matrix a 

corresponding to the orientation expressing part of a 4x4 " In ^ embodimentj in determining the spin angel, a 

homogeneous transformation matrix representing the 3Q method ^ employed which the spin ^ at ^ above . 

position/orientation of the tool coordinate system. The mentioned step (1) b t0 be reflected in &e torch 

matrix is composed of three rectangular unit vectors, that is, orientation which has been transformed to the program data 

a normal vector <N>, an orientation vector <0> and an corresponding t0 FIG. 2B from the program data corre- 

approach vector <A>. Thus, the vector (<N> <0> <A>) sponding to ^ 2A . This method has an advantage in that 

representing the tool orientation is called a .tool vector. 3S ^.^nin^f welding cable at me time 0 f playing back 

Hereafter, it is defined that "<>" represents a vector; "x" operation or an interference with a work piece due to the 

and "-"placed between vectors indicate an outerproduct and roUtion of ^ robot ^ around £he torch ^ made hafd tQ 

an mner product respectively. occur ^ processm g including the determination of the 

FIG. 4 is a view showing how to define the coordinate in angel ^ be explained h e rein after. 
system, the reference plane p\ the inclination angle 9 and the ^ 2 bl . From &e orien t a tion data at the teaching of the 
forward angle taking the sections AB, BC as an example. pQmt ^ ^ taught spin ^ (ta U ght_spin_ang) is deter- 
In this manner, one coordinate system is made for corre- ahe ^ D • detennm i ng process of the taught spin angle, 
sponding one section (such as AB or BC). Therefore it is ahh h {he mclination le and the forward ang i e at the 
possible to speafy a torch orientation (tool vector) with time of teach - ue ^ calclllated> tne data thereof 
respect to the corresponding weld line by calculating the 4J becomes unnecessary . 

torch orientation in a manner such that the inclination angle 2 bll . Usi the equatiotl r 3]> the , ool vector (<N> <0 > 

- 9 and the forward angle $ specified on the coordinate system ^ representing me too l orientation at the time of teaching 

are satefied. With reference to FIG. 5 and other figures, the fa transformed to the expression f<N> "<0> P <A>] on the 

embodiment of the present invention will be specifically coordinate system [tjvw] having been ^ady determined 

explained hereinafter. 50 f or eac ii section. In the expression, the upper left subscripf 

2. a: How to define a coordinate system for the section AB ^ ^ M a ^ for meaning ^ expr ession on the coor- 

(refer to FIG. 5) . dinate system [UVW]. 

A unit vector <U> m the direction from the point A to the 

point B is calculated by the following equation [1], and the r<N>, F <o>, '*<a>H<u> <v> <w>] _1 • [<u> <v> <w>] [3] 

vector is taken as the X-axis of a coordinate system to be J5 

determined. where Q" 1 represents the inverse matrix of the matrix []. 

<U>-<AB>/I<AB>I Til 2 ' b l " 2: ^ 6 taU S' 5t incmiaaon an g le at me ume °f 

*' teaching (expressed as taught__incl_ang) is calculated by 

where "|< >|" represents the absolute value of the vector. the following equation [4]. 

Then, the outer product <V> of a normal vector <n> of the 

reference plane and the unit vector <U> in the X-axial 60 taught_inci_ang=atan2 fAz^Ay) [4] 

direction is calculated by the following equation [2], and the _ , . 

product is taken as the Y-axis of a coordinate system to be In the ec l uatl0n . ^ A V are components in the Z-axis and 

determined Y-axis of P<A>; and atan2 (|1, |2) is in general a function 

which gives an output of angle ij> from inputs of |1 and |2, 

<v>=<n>x<u>/|< n >*<u>| [2] 6J in which CQS and sin ^ = g 2 holds. 

Finally, the outer product <W> of <U> and <V> is 2. b.1.3: Calculation of forward angle at the time of 

calculated, and the product is taken as the Z-axis of a teaching (taught_fwrd_ang) 
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First, the tool vector [ jP <N> i> <0> ^<A>] at the time of 

teaching is turned around <U> as the X-axis of the coordi- 04 = -fwrdL^mg [13] 
nate system [UVW] by (jt/2-taught__fwrd_ang) to produce 

a tqol vector [ p <N f > F <0'> P <A!>] representing a condition / c64 0 564 \ [14 ? 

in which an approach vector (an unit vector representing the 5 [*<it>?<o , >P<a , >] - 1 o i o 1 * [ p <n^<o^ t <a>\ 

torch direction) is placed on the X-Z plane of the coordinate \ .594 0 C94 / 

system [UVW]. This is determined by the following equa- rP » » , 

'tion [6], using the next equation [5]. Z b23: L <a,> <Q,> <a '>] is rotated around the x ' axis 

(<U>) of the coordinate system [UVW] by incL_ang-n/2. 

81 = (jc/2 - taught_>«f_^«^) [5] 10 ^ determined by the following equation [16] using the 

next equation [15]. 

(l 0 0 \ [6] 

F<Ar^<o^<A'>] - 0 cei -561 * [*<v>r<(hr<A>\ 85 = -^Uw* - ^ M 

\0 581 cei J /1 0 0 \ M 

In the equation [6], C01 and -S 81 represent sin 61 and cos 15 [ p <n n >P<o n >P<a n >] =» I 0 CQ5 0 J * pw^<0'^<a'>] 

01, respectively (hereafter, in the same manner). \ 0 ses C65 / 

The forward angle at the time of teaching (taughLjwrd_ * ' 

ang) is given by the following equation [7]. 2 ' h2A: ^ calculated tool vector F<n"> ^o'^ jP <a">] 

is transformed to the expression [<n"> <o"> <a">] on the 

taught_jnci_ang=atan2 f A'x/A'z) [7] 20 base coordinate system [UVW] which has been set to the 

robot. This is given by the following equation [17]. 

where p A'x, p A'z are components m the X-axis and Z-axis of r „ „ „ _ _ TT „ „ , r „ „ „ , r _ 

P < ^ > r [<n"> <o"> <a ,( >H<U> <V> <W>]* [ p <n"> F <o"> p <a">] [17] 

2. b.1.4: Calculation of spin angle at the time of teaching By calculating the above calculation on the respective 

(taught_spin_ang) 25 sections AB, BC . . . EF, a tool vector can be calculated 

First, the previously determined tool vector [ P <N> p <O f > which represents the basic welding orientation (refer to FIG. 

■<A'>] is rotated as the Y-axis of the coordinate system 2S ) at the respective points A, B . . . E. 

[UVW] by an angle of taught_fwrd_ang around <V> to 3. [Step (3)] 

produce a tool vector [ p <N"> p <0"> p <A">] representing a At this step, an automatic calculation is executed by 

condition in which an approach vector (an unit vector 30 software processings, which, using the program where the 

representing the torch direction) is coincident with <W> basic welding orientations shown in FIG. 2B are taught, 

which is the Z-axis of the coordinate system [UVW]. This is produces a program which realizes a smooth transition of the 

determined by the following equation [9], using the next torca orientation is in the subsection ranging from behind to 

equation [8]. before respective junction points by adding auxiliary points 

35 near the junction points B, C . . . E. The calculated results 

92 - taught_jwrd_ang [8] are stored in the nonvolatile memory 14. This provides a 

program which is expected to have the same quality as is 

t 9 ^ taught carefully by a skilled operator in the conventional 

p<^>^0 n >^yi = { o l o I * [ i, <w^ > <o , > J> <4 , >] method (refer to FIG. 1). 
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In this embodiment, auxiliary points are added before and 
behind respective junction points. However, the points may 
Then, the spin angle at the time of teaching (taught_ be added to only front or only behind the junction points. 
spin_ang) is determined by the following equation [10]. when the position of the auxiliary points has been deter- 
. mined by the automatic calculation, tool vectors at the added 

taug L_spm_aag=atan2 [ n y, x] [io] 45 reS p CCU y e auxiliary points and at the respective junction 

■ 2. b.2: From the calculated spin angle at the time of P oints are calculated t0 realize a smootn transition of the 
teaching expressed as (taught__spin„ang), and the inclina- torch orientation near me junction points, 
tion angle specified by inputting (expressed as incLang) Generally, the taught orientation at the junction points B, 
and the forward angle (expressed as fwrd_ang), a tool C ... E becomes different from the basic welding orientation 
vector representing the target torch orientation is calculated. 50 at &e junction points B, C . . . E shown in FIG. 2B. That is, 
2. b.2.1: A transformation matrix is determined which the tau § ht orientation is brought close to the basic welding 
represents the rotation with the same magnitude as taught^ onentatlon at ^ junction point immediately behind the 
spin_ang around <W> which is the Z-axis of the coordinate present junction point. For example, the taught orientation at 
system [UVW], That is, the matrix applying the rotation to **» j unction P oint B is brou S ht close to the basic weldin S 
the unit matrix is determined. This is determined by the 55 orientation at the start point A; and the taught orientation at 
following equation [12], using the next equation [11]. the j UDCti °n point C is brought close to the basic welding 

orientation at the start point B. 
j-jij The method of calculating the position of the auxiliary 
points to be added, and the method of calculating respective 
I 12 ] 60 junction points and tool vectors at the respective junction 
points will be sequentially explained hereinafter. For the 
start point A and the end point F, the basic welding orien- 
tations determined for the path AB and EF are used respec- 
2. b.2. 2: [ p <n> p <o> p <a>] is rotated around the Y-axis tively as the taught orientation. 
(<V>) of the coordinate system [UVW] by — fwrd_ang. 65 Although the number of added auxiliary points to be 
This is determined by the following equation [14], using the added may be two or more in all, including auxiliary points 
next equation [13]. before and behind the junction point, according to the 
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specification of the user, here the number is determined four 
including two points before and two points behind the 
junction point. FIG. 10 is a view for explaining how to 
determine the position of auxiliary points when two auxil- 
iary points each are provided before and behind the junction 5 
point B connecting the straight-line section AB with the 
straight-line section BC. 

A tool vector representing the orientation at the respective 
points a, b, c, d, e of FIG. 10 is calculated. Of those points, 
the points a, b, d, e are auxiliary points, while the point c is 10 
a point coincident with the junction point B. It is assumed 
that the distances between adjacent points are equal to each 
other, that is, ab=bc=cd=de (=pitch). At the points a through 
e, there is determined by calculation an intermediate orien- 
tation between the orientation (here a basic welding orien- 15 
talion determined for the point A) for the front side path A~B 
with respect to the junction point B and the orientation (here 
a basic welding orientation determined for the point B) for 
the rear side path B-C. 

Here, it is assumed that the orientation at the auxiliary 20 
point a is made to be coincide with the basic welding 
orientation determined for the start point A, while the 
orientation at the auxiliary point e is made to be coincide 
with the basic welding orientation determined for the junc- 
tion point B. Tool vectors at the midway auxiliary points b, 25 
c, d is determined in equally dividing relationship so that the 
torch orientation is smoothly changed through four small 
sections ab, be, cd, de. The calculation of the position of 
auxiliary points and the method of specifically calculating 
the equal division of orientation will be explained herein- 30 
after. 

3. a: Calculation of position of auxiliary points a, b to be 
set on path A-B in front of junction point B 

The auxiliary points a, b should be defined by the fol- 
lowing equations [18] through [20]. The meaning of <x>des -35 
used here is taken as follows: 

n: Number of auxiliary points to be set in front of (or 
behind) junction point B (user set value, two in case of 
FIG. 10) pitch: Auxiliary point inserting interval (user 
set value) 40 

<P1>: Vector representing point A 

<P2>: Vector representing point B 

i: Auxiliary point number (i-0 for a, i=l for b, in case of 
FIG. 10) 45 

<Li>: Vector going from point B toward the i-th auxiliary 
point 

<Pai>: Vector representing the i-th auxiliary point deter- 
mined by calculation 

50 

*>n^S — -p"-«-o tl8] 

<Pai> = <p2> + <Li> [19] 

-1^=36 — •^•< B -' [20]5S 
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n: Number of auxiliary points on path in front of junction 
point B (=number of auxiliary points on path on rear 
side of junction point) (both are user set values) 

i: Auxiliary point number (0^i^2n; in case of n=2, i=0, 
1, 2, 3,4) 

weld_dir_vec 1: Unit vector representing advance direc- 
tion of the path in front of junction point 

weld_dir__yec 2: Unit vector representing advance direc- 
tion of the path on rear side of junction point 

[<Ns> <Os> <As>]: Tool vector corresponding to orien- 
tation 1 

[<Ne> <Oe> <Ae>]: Tool vector corresponding to orien- 
tation 2 

<k0>: Normal vector of plane including weld_dir__vec 1 

and weld„dir__vec 2 (generally not unit vector) 
tO: "Angle between weld_dir_yec 1 and weld_dir_vec 2 
3. c. 1: Calculation of vector <k0> and angle tO 
(calculation of orientation 2 1 ) 

The vector <k0> is calculated by the following equation: 

<kO>=weld_dir_vec lxweld — dir__vec 2 [21] 

sO, a sine of an angle between a vector weld_dir__vec 1 
and a vector weld_dir„vec 2, and cO, a cosine of the angle 
are given by the following equations [22] and [23], respec- 
tively: 

s0-|<k0>| [22] 
cO*=weld_dir__vec l"weld„dii_vec 2 [23] 
Also, the angle tO is given by the following equation [24]: 

t0=atan2 (sO, cO) [24] 

Then, a vector [<Ne*> <Oe f > <Ae'>] corresponding to the 
orientation 2* which is obtained by rotating the orientation 2 
around the vector <k0> by an angle -tO is calculated by the 
following equation [25]: 

[<Ne'> <Oe'> <Ae'>]=Rot (<k0>, -tO) * [<Ne> <Oe> <Ae>] [25] 

Generally, Rot (<V>, 0) represents a transformation matrix 
performing the rotation of an angle 0 around the vector <V>. 
However, if sO is a very small positive number, then the 



following settings may be possible: 

<k0>-(1.0 0.0 0.0) [26] 

KMJ.0 [27] 

[<Ne'> <Oe'> <Ae*>]=[<Ne> <Oe> <Ae>] [28] 



Where the vector <V> is a unit vector, and when the 
following equations are set: 



[19] 
[20] 55 



3. b: Calculation of position of auxiliary points d, e set on 
path B-C on the rear side of junction point B 

This calculation is made by the calculation similar to the 
above-described 3. a. Therefore, the description of the 
calculation equations will be omitted. 

3. c: Calculation of orientation at auxiliary points 

With a change in the orientation at a junction point taken 
as a change from an orientation 1 to an orientation 2, a 
method of calculating an intermediate orientation between 
the orientation 1 and the orientation 2 will be explained. 
Hereafter, codes i and n are taken as the following meanings; 



60 



<v>* 



versB « 1 - cos8, 



Rot (<V>, 0) is given by the following equation [29]. If <V> 
65 is not a unit vector, a unit vector is obtained by dividing 
respective elements of <V> by |<V>| before calculating the 
equation [29]. 



11 



12 



(vx*vx*versQ + cos 0 vy*vx*versdvz*sin 8 vz*vx*vers6 + vy*sin 0 ^ 1^9] 
vce*vy*vera9 + vr*sin 0 vy*vy*ver$9 + cos 8 vz*vx*versQ + vx*&m 6 
vx*vz*versQvy*sw 9 vy*vi*vers9 + i#*sin 6 vz*vz*veKs9 + cos 9 

3. c. 2: Calculation of <kl> and tl (calculation of orien- Note that atan2 is outputted (defined) even when s2=0 is 

tation 1') inputted. 

The orientation 2 r determined in the above paragraphs c. Now, the vectors <k2> and <Ae'> are vectors facing each 

1 corresponds to the one which is obtained by rotating the 10 other in the same or reverse direction, and whether the 

orientation 2 (so as to be brought close to the orientation 1) direction is same or reverse can be judged by the sign of the 

around the normal of a plane including the welding path inner product of both if calculated. Thus, "save__sign" is 

before and behind a junction point. Now, as a process for defined as follows: 
further eliminating a difference between the orientation 2' 

and the orientation 1, a transformation will be considered in is save_5ign«<k2>*<Ae'> [41] 

which both approach vectors are superposed on each other. ™ . r * . * . r 

r- * *u i_ * r *u • * *• 1 * The sign of save sign is utilized later tor judging or 

First, the approach vector of the orientation 1 is super- * — & j & & 

posed on the approach vector of the orientation 2' by a processing. t 

shortest rotation to produce the orientation 1A The vector 3 n c ' 4 j E 5 ua *™ P™™g 

acting as a rotating center at that time is taken as <kl>; and 20 ^J 0 * 1 1 T? er 0 7 

the rotational angle, as tl (OStlS*). TOe description of * nd behind juncton points and the junction points 

equations [30] through [34] representing <kl>, tl and the themselves, the * of onentations to be calculated for 

related auantitv is as follows' one J 1111011011 P omt 15 P*™ h==2n+1 ( m the example of 

4 y * FIG. 10, n-2, thus h=5, so that total number is five for of 

<kl>=<As>x<Ae-> [30] ^ points a through e). 

First, a vector [<N1> <01> <A1>] corresponding to an 
sl=|<kl>| [31] orientation obtained by rotating the orientation 1 around the 

.„ „ . „ . . , , „ „ . vector <k0> by tO* i/2n is determined by the following 

where if si is a very small positive number, the following eauation T421 

setting [32] will be also possible: * ^ 42 ] 

30 [<N1> <01> <Al>]=Rot{<kO>, (tO * i/2n)}* [<Ns> <Os> <As>] 



kl=<Ne'> [32] 
cl=<As>»<Ae'> [33] 



Further, an orientation <kl f > obtained by rotating the vector 
<kl> around the vector <k0> by tO * i/2n is determined by 
ti=atan2 (si, el) [34] the following equation [43]. 

- -35 ~ 

where, note that atan2 is outputted (defined) even when sl=0 <kr>«Rot {<k0>, (to * i/2n)}* <kl> [43] 

is inputted. 

Then, the orientation 1' obtained by rotating the orienta- Then, [<N2> <02> <A2>] obtained by rotating [<N1> 
tion 1 around the vector <kl> by the angle tl is calculated. <01> <A1>] around <kT> by tl * i/2n is determined by the 
A tool vector [<Ns'> <Os'> <As'>] corresponding to the 40 following equation [44]. 

orientation V is given by the following [35]: E 44 3 

[<N2> <02> <A2>]«Rot{<kl*>, (tl * i/2n)}* [<Nl> <01> <A1>] 

[<Ns*> <Os'> <As'>]=Rot (<kl>, tl) * [<Ns> <Os> <As>] [35] 

Further, according to the sign of save_sign, <k2> is 
3. c. 3: Calculation of <k2> and t2 defined as follows: 

With respect to the direction around an approach vector, 45 
there is a deviation between the orientation 2' calculated in For save_j5ign<0:<k2>~-A2 [45] 



the above paragraphs, 3. c. 1 and 3. c. 2, and the orientation 
1'. Thus, as a process for eliminating the deviation between 



For save_jsign^0: <k2>=A2 [46] 



the both a rotational transformation for removing the devia- FinaU [<Ni> <Qi> ^ obtained by rotating [<N2> 

tion will be cohered ^ 50 <02><A2>] around <k2> by t2 * i/2n is determined by the 

A vector acting as a rotational center is taken as <k2>; ana fnllnwincr equation T471 
the rotational angle, as t2 (O^tl^Jt). <k2> is an approach g q J " ^ 

vector of both orientations or a vector obtained by making [<Ni> ^ <Ai>].RDt{<k2>, (t2 * m)}* [<N2> <02> <A2>] 

the approach vector reversal. The description of equations 

[36] through [40] representing <k2>, t2 and the related 55 gy performing the processing including the above- 
quantity are as follows: described calculation contents on individual junction points, 

the position of auxiliary points in the above paragraphs, 3. a 
<k2>~<Ns'>x<Ne'> [36] and 3 b) md ^ orientat { 011 at &e auxiliary points (and 

s2»|<k2>| [37] junction points) in the paragraph, 3. c are determined. 

60 Therefore, by combining them, all position data relating to 
where if s2 is a very small positive number, the following respective junction points will obtained, 
setting [38] may be possible: 4. [Teaching processing] 

On the basis of the above-mentioned description, the 
ns=<AQ,> E 38 l procedure and processing of the teaching method in this 

c2=<Ns'>-<Ne'> [39] 65 embodiment, mainly the operation an operator performs, 

will be further explained hereinafter. 

t2=atan2 (s2, c2) [40] 
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[Preparation] 

(1) First, for the preparation to perform the teaching of the 
torch orientation, the operator teaches sequentially the start 
point, end point and junction points on the welding path as 
shown in FIG. 2Aby jog feed without paying any attention 
to the torch orientation as the data for motion program. It is 
preferable, during the teaching, to avoid a change of torch 
orientation which will induce a cable twining. 

(2) Then, an operation screen of the torch orientation 
quick teach function is displayed on the LCD 17 of the 
teaching pendant 18. This is shown in FIG. 6. 

[Operation/processing execution procedure] 
With reference to the flow chart of FIG. 12, the outline of 
the operation/processing execution procedure after the 
operation screen of the torch orientation quick teach func- 
tion is displayed will be explained. 

(3) First, a program name ("TEST") of a program which 
becomes a transformation source and is taught in the 
[preparation 1] is inputted (step SI), and then a scope to be 
transformed is specified (steps S2 through S5). The trans- 
formation scope is specified in such a manner that either 
whole or part of the program be selected (step S2), and in 
case of part (step S3), the selected scope be specified with 
the row numbers (numbers of a transformation start row and 
transformation end row) of the program (steps S4, S5). 

(4) Then, whether the transformed part is newly 
"produced", or "replaced" by part specified by the transfor- 
mation source is set (step S6). When nothing is set at the 
step, "replaced" is considered to be set. 

(5) When "produced" is set at the above-mentioned (4) 
(step S7), the program name of the program distined to be 
transformed is inputted (step S8), however when "replaced" 
is set, the operation to input the program name of the 
program distined to be transformed is not required. 

(6) If the program name inputted in the above-mentioned 
(5) has been registered, the number of the row corresponding 
to the transformed part to be inserted is set. Where the 
program is an unregistered (newly produced) program, such 
setting is not required. 

(7) Then, the page switching key is depressed to cause 
"Welding orientation automatic calculation screen" to be 
displayed on the screen of the LCD 17. This is shown in FIG. 
7. 

(8) On "Welding orientation automatic calculation 
screen", first, whether the reference plane which is a plane 
used for setting an inclination angle is taught or not is set by 
selecting "Yes" or "No". When the reference plane is not set 
by teaching, the plane parallel to the robot installing plane 
(floor plane) is considered to be set as the reference plane. 
The data on the reference plane is given in the form of the 
data on normal vectors. The direction of the reference plane 
is specified by the direction of the normal vector. 

(9) When in the above-mentioned (8), the teaching of the 
reference plane is selected (step S9), the reference plane is 
taught (step 10). Using a teaching pendant 18, the torch head 
is caused to move by the jog feed operation, and the position 
of three points (provided that the points be selected in a 
condition in which they are not located on one straight line) 
on the reference plane desired to be set should be taught. The 
torch orientation at the time of teaching is optional. 

(10) The inclination angle G and the forward angle § 
desired for each section should be inputted with a numerical 
value (steps Sll, S12). 

(11) To execute the processing of "Torch orientation 
automatic calculation", the function key "TRANSFORMA- 
TION" should be depressed. This causes the processing of 
"Torch orientation automatic calculation" to be started, 
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whereby the basic welding orientation satisfying the condi- 
tions of the desired inclination angle 9 and the forward angle 
<j> is calculated for each section (refer to FIG. 2B). 
Now, let corner part be a part where in which a straight- 

5 line section with a length more than a predetermined value 
crosses at a junction point with another straight-line section 
with a length more than a predetermined value, for example, 
a part in which on the weld line of FIG. 2B, the straight-line 
section B-C crosses at the connection point C with the 
straight-line section C-D. If the weld line has no corner part 
(step S13), this means that there is no junction point for 
which "Calculation for smooth orientation change" must be 
executed, or the welded line, so that the welding program 
will be completed at this step. 

For example, this applies to a case where two semicircle 
paths (HIJ and JKH) are connected into a circle to weld the 
circumference, as shown in FIG. 11. In such a case, the 
X-axis direction of the coordinate system [UVW] set on 
each of points H through K is specified at the tangent line 

2Q direction at each of the points H through K on the circler arc 
path, so that the basic welding orientation at the points H 
through K is calculated by the above-mentioned calculation 
process. 

(12) On the contrary, when the weld line has a corner part, 
25 the page switching key should be further depressed to cause 

the execution screen of "Automatic calculation for smooth 
orientation change" to be displayed. This is shown in FIG. 
8. 

(13) In this screen, first, the number n of auxiliary points 
3Q to be inserted into positions before and behind a junction 

point forming the corner part is set (step S14). FIG. 10 
shows an example in which n=*2 is set. 

(14) Then, the inserting interval (the above-mentioned 
"pitch") of auxiliary points should be inputted with a 
numericaWahie (step 15). 

" '((i5) Finally, depressing the function key "EXECUTION" 
of the teaching pendant 18 causes the processing of the 
automatic calculation for smooth orientation change to be 
executed (step 16). Here, for junction points forming the 
4Q corner part in the path programmed within the scope speci- 
fied by the program (TEST), the position of auxiliary points 
is calculated under the above-mentioned set condition (n, 
pitch), and then, a welding program for realizing a smooth 
torch orientation change (transition) is automatically pro- 
duced (step S17). 



